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© METHOD OF CONTROLLING FEED-FORWARD OF SERVO MOTOR. 



© The instruction follow-up ability of a servo system is improved. The mean value of move instructions in each 
of position/speed loop processing cycles is determined, the number of the move instructions being equal to the 
quotient N of the division of a distribution cycle by the position/speed loop processing cycle with the cycle of a 
position/speed loop processing as the center. A feed-forward quantity FFp of a position is determined by 
t- multiplying this mean value by a position feed-forward coefficient (S13), and this feed-forward quantity FFp is 
< added to a speed instruction obtained by a normal position loop processing to obtain a corrected speed 
Csj instruction Vc(j) (S14). Furthermore, speed feed-forward processing, too, is carried out (S16) to obtain a torque 
r- instruction Tc(j) for driving a motor (S17). Even when feed-forward control is effected, undulation does not exist 
^ in position error, and no shock occurs in a machine. 
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Technical Field 



The present invention relates to a control method for a servomotor for driving a feed shaft of a machine 
tool or a robot arm, more particularly, to a feedforward control method for a servomotor. 

5 

Background Art 

In controlling a feed shaft of a machine tool or a robot arm by means of a servomotor, feedforward 
control is used in order to reduce the position deviation. When using the machine tool for high-speed 

w cutting, in particular, shape errors are liable to be caused by a follow-up delay of a servo system. Thus, a 
position loop is feedforward-controlled to reduce these errors. 

In the conventional feedforward control, variation of a move command for each position and speed 
processing period is differentiated, and a value obtained by multiplying the resulting differential value by a 
feedforward coefficient is added to a speed command obtained in a conventional position loop processing, 

ts thereby correcting the speed command. A speed loop processing is executed in accordance with the 
corrected speed command to reduce the position deviation, thereby correcting the servo delay. 

However, a distribution period (ITP period) during which the move command is delivered from a 
numerical control device to a servo circuit side, that is, the position loop, is about 8 msec, and the period of 
a position/speed loop in the servo circuit is 2 or 1 msec. The position loop is controlled so that the ITP 

20 period, during which the move command is delivered from the numerical control device, is divided into 
position loop periods, and move commands for the individual divided position loop periods are equal. Thus, 
even though an acceleration/deceleration time constant is given to the move command outputted from the 
numerical control device, the position loop is controlled so that the move commands for individual position 
loop processing periods Tp in each ITP period are equal. Accordingly, a great difference is produced 

25 between the move commands for the position loop processing periods at the turning of the ITP periods, and 
this is differentiated into a great value by means of a feedforward term. Thus, the speed command contains 
a high-frequency component, which cannot be followed up in a speed loop. As a result, the position 
deviation is subject to variation, causing a great shock on the action of the motor or machine. 

In order to eliminate this drawback, the inventor hereof filed an international application 

30 (PCT/JP90/00380) for the following invention, which was internationally published as International Publica- 
tion No. WO90/11562. According to this invention, an acceleration/deceleration processing is inserted in a 
feedforward term for speed control, as well as for position control, and a smoothing processing is executed 
to remove the variation. In this smoothing operation, past data are leveled, and a time delay is equivalently 
caused in the feedforward term. 

35 

Disclosure of the Invention 

According to the present invention, the average value of move commands for N number of 
position/speed loop processing periods centering around a position/speed loop processing period of the 

40 present processing is obtained, where N is the number of the position/speed loop processing periods by 
which an ITP period is divided, and a speed command for a speed loop processing is obtained by adding a 
position feedforward amount, which is obtained by multiplying the average value by a position feedforward 
coefficient, to a speed command obtained in a position loop processing. 

Further, the differential value of the average value for the position/speed loop processing of a period, 

45 which is later than the position/speed loop period for the present processing by being advanced by a preset 
number of periods, is obtained, and a torque command for the servomotor is obtained by adding a speed 
feedforward amount, which is obtained by multiplying the differential value by a speed feedforward 
coefficient, to a torque command value obtained in the speed loop processing. 

A move command for an ITP period one cycle later than the ITP period for the present processing are 

so previously read so that the move command for the position/speed loop processing period is obtained 
beforehand. A position feedforward amount FFp is obtained by using an average value b(j) of move 
commands for N number of periods centering around a position/speed loop processing period j, where N is 
the value obtained by dividing the ITP by the number of the position/speed loop processing periods which 
a1 is the position feedforward coefficient, P is a coefficient for converting the unit of move command pulses 

55 into a speed command unit, and a(j) is a move command for the period j. Normally, however, 8 msec and 1 
or 2 msec are used for the ITP period and the position/speed loop period, respectively, so that the number 
N is an even number. Based on the position/speed loop processing period j concerned, therefore, the 
position feedforward amount FFp is obtained in accordance with an average value for a range from a period 
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(N/2 - 1 ) cycles later than the period j to an N/2-cycle-earlier period, or from an N/2-cycle-later period to an 
(N/2 - 1)-cycle-earlier period. 

The average value b(j) for the range from the (N/2 - 1)-cycle-later to the N/2-cycle-earlier period is given 
by the following equation (1). 

5 

ii 

b(j) = { * a(j - k)}/N. (1) 

K = +1 

10 

The average value b(j)' for the range from the N/2-cycle-later period to the (N/2 - 1)-cycle-earlier period 
is given by the following equation (2). 



15 



b(j)' = 



JL. 



a(j - k)}/4 



(2) 



20 The position feedforward amount FFp is obtained by multiplying the aforesaid average value b(j) by the 
coefficients P and o1, as indicated by equation (3) as follows: 

FFp = a1«P-b(j). (3) 

Alternatively, the feedforward amount FFp may be obtained by using the aforesaid average value b(j)' in 
like manner. 

Further, the position feedforward amount FFp may be obtained by taking the weighted average, that is, 
b(j)" = {bG) + b(j)'}/2, of the aforesaid average values b(j) and b(j)' and multiplying it by the coefficients P 
and a1. 

The position feedforward amount FFp obtained by making the calculation according to equation (1) or 
(2), or on the basis of the weighted average of values obtained by making the calculations according to 
equations (1) and (2) is added to the speed command obtained in the position loop processing for the 
period j concerned, and the resulting sum is used as a speed command for the speed loop processing. 

Furthermore, a speed feedforward amount FFv is obtained according to the following equation (4) by 
multiplying the differential value of an average value b(j + L) for a period advanced by L number of cycles, 
obtained according to equation (1) and the like, by the coefficient P for converting the unit of the move 
command pulses into the speed command unit, the speed feedforward coefficient a2, and a coefficient P' 
for converting the unit of the move command pulses into a current unit. 

40 FFv = a2.P*P'{b(j + L) - b(j + L - 1)}. (4) 

The torque command for the servomotor is obtained by adding the speed feedforward amount FFv, 
obtained according to equation (4), to the torque command (current command) obtained in the speed loop 
processing, 

45 

Brief Description of the Drawings 

Fig. 1 is a block diagram of a servo system showing one embodiment of the present invention; 
Fig. 2 is a block diagram of a digital servo control device for carrying out the embodiment; 
so Fig. 3 is a flow chart showing a processing executed by a processor of a digital servo circuit for every 
ITP period; 

Fig. 4 is a flow chart showing a position/speed loop processing; 

Fig. 5 is a diagram for illustrating average values of move commands for computing a position 
feedforward amount; 

55 Fig. 6 is a graph showing the transition of a position deviation observed when ramp input is applied to 
the move commands in a conventional servo system for feedforward control; 

Fig. 7 is a graph showing the transition of a position deviation observed when ramp input is applied to 
the move commands with a lead L for speed feedforward control at 0 according to the one embodiment 
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of the present invention; 

Fig. 8 is a graph showing the transition of a position deviation observed when ramp input is applied to 
the move commands with the lead L for the speed feedforward control at 2 according to the one 
embodiment of the present invention; 
5 Fig. 9 is a diagram for illustrating average values obtained by a smoothing processing; 

Fig. 10 is a flow chart showing a processing executed by a processor of a digital servo circuit according 
to an alternative embodiment of the present invention with every ITP period; 

Rg. 11 is a flow chart showing a processing for obtaining position feedforward in a position/speed loop 
processing according to the alternative embodiment; and 
w Fig. 12 is a diagram for illustrating a processing for obtaining average values. 

Best Mode of Carrying Out the Invention 

Fig. 1 is a block diagram of a servo system according to one embodiment of the present invention. In 
75 Fig. 1 , Kp of a transfer function 1 represents a position gain of a position loop; a transfer function 2, an 
integral term of a speed loop; Ts, the period of a position/speed loop processing; and k1, an integral gain of 
the speed loop. Also, k2 of a transfer function 3 represents a proportional gain; 4, a mechanical section of a 
servomotor; Kt, a torque constant; and Jm, inertia. A transfer function 5 integrates the rotating speed of the 
servomotor, thereby computing the position. Further, a smoothing circuit 6 and a term 7 for multiplication by 
20 the position feedforward coefficient a1 are terms for position feedforward. 

A transfer function 8 advances the output of the smoothing circuit 6 by a predetermined number of 
position/speed loop processing periods. Numerals 9 and 10 designate a transfer function for differentiation 
and a term for multiplication by the speed feedforward coefficient a 2, respectively. The elements 8, 9 and 
10 are used for speed feedforward control. A DDA (digital differential analyzer) 11 divides a move command 
25 Mcmd, which is delivered from a CNC (computerized numerical control device) with every distribution 
period (ITP period), into move commands for the individual position/speed loop processing periods. 

Of the transfer functions described above, the transfer functions 2, 8 and 9 are represented in a discrete 
value control system. 

The move command Mcmd for each ITP period is delivered from the CNC as a host control device, and 
30 a move command a for the position/speed loop period is obtained by means of the DDA 11. In order to 
obtain the feedforward amount FFp by means of the elements 6 and 7, it is necessary to obtain a move 
command for the ITP period of one cycle later in advance, so that the move command for the one-cycle- 
later ITP period is obtained beforehand by means of the DDA 11. 

The move command a for the position/speed loop processing for executing the processing concerned is 
35 obtained, and a position deviation is obtained by subtracting a feedback amount Pf of the actual movement 
of the servomotor from the move command a for the position/speed loop period concerned. A speed 
command is obtained by adding, to the value obtained by multiplying the positional deviation by the 
positional gain Kp, the position feedforward amount FFp, which is obtained by making the calculation 
according to equation (1) or (2) by means of the elements 6 and 7 or on the basis of the weighted average 
40 of values obtained by making the calculations according to equations (1) and (2). 

A speed deviation is obtained by subtracting a feedback amount Vf of the actual speed of the 
servomotor from the speed command; a value obtained by multiplying the actual speed Vf of the 
servomotor by a proportional constant k2 is subtracted from a value obtained by integrating the speed 
deviation by means of the element 2; and a torque command is obtained by subjecting the resulting value 
45 to the same integral and proportional speed loop processings as the conventional ones. 

Further, the speed feedforward amount FFv is obtained by making the calculation according to equation 
(4) by means of the elements 8, 9 and 10; a feedforward-control led torque command Tc is obtained by 
adding this speed feedforward amount FFv to the torque command which is obtained by the conventional 
processings; and the servomotor is driven, 
so Rg. 2 is a block diagram of a digital servo control device for carrying out one embodiment of a method 
according to the present invention. Since this device is arranged in the same manner as a conventional 
device for digital servo control, it is illustrated schematically. 

In Rg. 2, numeral 20 denotes a computerized numerical control device (CNC); 21, a common RAM; 22, 
a digital servo circuit including a CPU, ROM, RAM, etc.; 23, a servo amplifier such as a transistor inverter; 
55 24, a servomotor; and 25, a pulse coder which generates pulses as the servomotor 24 rotates. 

The CNC 20 writes the move command Mcmd, which is supplied with every ITP period (distribution 
period), in the common RAM 21 , and the CPU of the digital servo circuit 22 reads this move command 
Mcmd from the common RAM 21 , and executes the position/speed loop processing with the period Ts (ITP 
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= Ts • N) which is obtained by dividing the ITP period into N number of equal parts. The move command 
a(j) for the position/speed loop processing Ts is obtained so that the move command Mcmd delivered from 
the NC 20 with every ITP period is equally distributed during the ITP period. A position loop processing is 
executed on the basis of the difference between the move command a(j) and the present position of the 

5 servomotor 24, which is obtained according to feedback pulses from the pulse coder 25, and a position 
feedforward control processing (mentioned later) is executed to obtain a speed command. Then, a speed 
feedforward processing, as well as a speed loop processing, is executed in accordance with the speed 
command and the actual speed of the servomotor 24, which is obtained according to the feedback pulses 
from the pulse coder 25, and a torque command (current command) is obtained. Further, a current 

10 feedforward processing, as well as a current loop processing, is executed; a PWM command is created; 
and the servomotor 24 is driven by means of the servo amplifier 23. 

Figs. 3 and 4 are flow charts showing a move command reading processing for each ITP period, which 
is executed by the CPU of the digital servo circuit 22, and the position/speed loop processing for each 
position/speed loop processing period, respectively. 

75 In the present embodiment, the position/speed loop processing is executed with the ITP period divided 
into four (parts) (N = 4). In order to obtain the position feedforward amount FFp, the b(j) obtained by the 
aforesaid equation (1) is used as the average value of move commands of N number of periods centering 
around the period concerned. The following is a description of a case of the speed feedforward processing 
with an advance of two periods (L = 2). Thus, the average value bO) of the move commands is given by 

20 the following equation (5), and the feedforward amount FFp is given by equation (6). 

b(j) = { £ a(j - k)}/4 

25 

= {a(j + 1) + a(j) + a(j - 1) + a(j - 2)}/4 

(5) 

30 FFp = al -P-b(j) 

= crl-P{a(j + 1) + a(j) + a(j - 1) + a(j - 
2)}/4 (6) 

35 

According to equation (4), the speed feedforward amount FFv is given by the following equation (7): 

FFv = a2-P-P'{b(j + 2) - b(j + 1)} 
40 = a2'P-P'{a(j + 3) - a(j - l)}/4 

(7) 

45 Referring to the flow charts of Figs. 3 and 4, the position/speed loop processing executed by the CPU 
of the digital servo circuit 32 will be described in connection with the above-described case as an example. 

First, in Step S1, the CPU reads from the common RAM 21 the one-cycle-later move command Mcmd 
delivered from the NC 20 with every ITP period. Actually, the position/speed loop processing which will be 
described later, is executed in response to a move command for the ITP period of one cycle later, so that 

5d the move command Mcmd delivered from the NC 20 with every ITP period is read out. 

Subsequently, the CPU starts a processing shown in Fig. 4 for every position/speed loop processing 
period. First, in Step S10, a move command a(j + 4) for each position/speed loop is computed in 
accordance with the distributed move command Mcmd read with every ITP period. Then, in Steps S11-1 to 
S11-7, the move command a(j + 4) computed in Step S10 is loaded into a register R(j + 4), and the 

55 respective storage contents of registers R(j - 2) to R(j + 4) are shifted by one each. More specifically, the 
storage contents of the registers R(j - 1), R(j). RG + 1 )» R (i + 2), R(j + 3) and R(j + 4) are stored in the 
registers R(j - 2), R(j - 1), R(j), R(j + 1), R(j + 2) and R(j + 3), respectively. The storage content of each 
register is "0" before the distributed move command Mcmd is outputted. 
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Then, in Step S12, the move command a(j) for the present period stored in the register R(j) is added to 
a position deviation e(j - 1) of the preceding position/speed loop period stored in the register (in Step S12), 
and a position feedback amount pf(j) for the movement of the servomotor detected by means of the pulse 
coder 25 is subtracted to obtain a position deviation e(j) for the present period. 
5 Since the move command Mcmd for the ITP period is read one cycle earlier, the move command a(j) 
for the position/speed loop period concerned is stored in the register R(j), the fourth immediate predecessor 
of the register R(j + 4), which is loaded with the move command a(j + 4) computed during the present 
period. 

Then, in Step S13, the average value bQ) is obtained by making calculation according to equation (5) 
w using the move commands atf + 1), a(j), a(j - 1) and a(j - 2) stored in the registers R(j + 1), R(j), R(j - 1) 
and R(j - 2), respectively. The position feedforward amount FFp is obtained by multiplying the average 
value b(j) by the coefficients cr1 and P. 

In Step SI 4, a speed command Vc(j) is obtained by adding the position feedforward amount FFp, 
obtained in Step S13, to the product of the position deviation eG), obtained in Step S12, and the position 
75 loop gain Kp. In Step S15, a torque command Tc'fj) is obtained by executing the same speed loop 
processing as the conventional one on the basis of the speed command Vc(j). 

Then, in Step S16, the speed feedforward amount FFv is obtained by making calculation according to 
equation (7) using the move commands a(j + 3) and a(j - 1) stored in the registers R(j + 3) and R(j - 1), 
respectively. 

20 Subsequently, the program proceeds to Step S17, whereupon correction is made by adding the speed 
feedforward amount FFv, computed in Step S16, to the torque command Tc'G), obtained in Step S15, 
whereby a corrected torque command Tc(j) is obtained. In Step S18, the torque command Tc(j) is delivered 
to the current loop processing, whereupon the position/speed loop processing is finished. 

Table 1 and Figs. 5 and 6 show an example of the present embodiment. Move commands Mcmd(n) for 

25 the individual ITP periods are inputted as indicated by A in Fig. 5, and the move command a(j) for each 
position/speed loop processing period is obtained from these commands. The average value b(j) is obtained 
from this move command a(j) as indicated by B in Fig. 5. 

Table 1 shows the values of the move commands a(j + 4) to a(j - 2) stored in the registers R(j + 4) to 
R(j - 2), and the average value b(j) respectively. Also shown are the average value b(j)' obtained according 

30 to equation (2), and the value b(j)" indicative of the weighted average of the average values b(j) and b(j)*. 
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As seen from Fig. 5 and Table 1, the average value b(j) and hence the position feedforward amount 
FFp, obtained on the basis thereof, undergo no sharp change even though the move command a0) 
55 suddenly changes with every ITP period. Thus, the change is not so sharp as that in the case of the 
conventional feedforward control, in which a feedforward amount obtained by multiplying the differential 
value of the move command by a coefficient is used, accordingly variation of the position deviation can be 
eliminated. 
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Fig. 6 is a graph obtained by detecting the position deviation when ramp input is applied to the move 
command in the case of the conventional feedforward control, in which the feedforward amount obtained by 
multiplying the differential value of the move command by the coefficient is used. Fig. 7 is a graph obtained 
by measuring the position deviation when ramp input is applied to the move command in the case where 
5 the data for the speed feedforward control according to the present invention is not advanced (L = 0). Fig. 
8 is a graph obtained by measuring the position deviation when the data according to the present invention 
is advanced for two periods (L = 2). As seen from Figs. 6 to 8, the feedforward control according to the 
present invention, compared to the conventional feedforward control, is improved in reducing the variation of 
the position deviation. 

10 In the above embodiment, the move commands for the one-cycle-later (future) period (j + 1), present 
period j, one-cycle-earlier (past) period (j - 1), and two-cycle-earlier (past) period (j - 2) of the present 
position/speed loop processing period j are leveled. Alternatively, however, the move commands for the 
periods (j + 2), (j + 1), j and (j - 1) may be leveled according to equation (2). In this case, the average 
value is the value given by bfl)' in Table 1, and is shifted to the left by one period Ts as in Fig. 5b. 

;5 If the number N resulting from dividing the ITP period by the position/speed loop periods is an even 
number, the position/speed loop period which is expected to be the center of leveling fails to be the exact 
center of the N number of position/speed loop periods. Thus, the position feedforward amount FFp leads or 
delays by half the length of the position/speed loop period. This phenomenon, which is evident from Figs. 1 
and 5, will now be described further in detail. 

20 Let us suppose that four-by-four move commands Mcmd with the ITP period are delivered for one 
period, as shown in Fig. 9a. If the move command a for each period is obtained where j = 0 for the 
position/speed loop period of the ITP period concerned, in obtaining the feedforward amount by taking the 
average according to equation (1), the average value varies in the order of 1, 2, 3, 4, 3, 2 and 1 as the 
period j varies from j = - 1 to j = 5, as shown in Fig. 9b. If the average value is obtained according to 

25 equation (2), on the other hand, it varies in the order of 1, 2, 3, 4, 3, 2 and 1 as the period j varies from j = 
-2 to j = 4, as shown in Fig. 9c. Thus, a half-cycle delay and a half-cycle lead are caused in the cases of 
Figs. 9b and 9c, respectively. Thereupon, if the weighted average b(j)" of the average value b(j) obtained 
according to equation (1) and the average value b(j)' obtained according to equation (2) is taken, it varies in 
the order of 1/2, 3/2, 5/2, 7/2, 7/2, 5/2, 3/2 and 1/2 as the period j varies from j = -2 to j = 6, as shown in 

30 Fig. 9d. Therefore, the time delay and lead are eliminated equivalently. 

Referring now to Figs. 10 and 11, an embodiment will be described as a case where the average value 
is obtained not from the move command a for the position/speed loop period, which can be obtained by 
means of the DDA 11, but from the move command Mcmd issued with every ITP period. 

In this embodiment, a processing will be described for the case where the position feedforward amount 

35 FFp is obtained and controlled in accordance with the weighted average b(j)". 

The CPU of the digital servo circuit 22 executes the processing of Fig. 10 with every distribution period. 
First, in Step T1 , values stored individually in registers R2 and R1 are loaded into registers R3 and R2, 
respectively, and in Step T2, the one-cycle-later move command Mcmd read from the common RAM 21 is 
loaded into the register R1. Then, in Step T3, a counter T is cleared to "0". In this manner, a move 

40 command Mcmd for the period one cycle earlier (past) than the ITP period concerned is stored in the 
register R3; a move command Mcmd for the period concerned is stored in the register R2; and a one-cycle- 
later (future) move command Mcmd is stored in the register R1. Actually, however, it is necessary only that 
the values stored individually in the registers R2 and R1 be loaded into registers R3 and R2, respectively, 
and the distributed move command MCDM into the register R1. As will be described later, the 

45 position/speed loop processing is executed delaying by by one ITP period. For initialization, the registers 
R1 to R3 are first loaded with "0". 

On the other hand, the CPU of the digital servo circuit 22 executes a processing shown in Hg. 11 after 
executing a computation processing (processing of Step S12 in Fig. 4) for the position deviation with every 
position/speed loop processing period. In Fig. 11, only a processing for obtaining the position feedforward 

so amount is shown, and other processings are omitted. 

First, in Step T10, it is determined whether or not the value in the counter C is smaller than 1/2 of the 
value N obtained by dividing the distribution period by the position/speed loop processing period. If the 
counter value is smaller than N/2, the program proceeds to Step T11, whereupon a value obtained by 
subtracting the value in the register R3 from the value in the register R2 is added to the value in an 

55 accumulator SUM. If the value in the counter C is not smaller than N/2, the program proceeds to Step T12, 
whereupon a value obtained by subtracting the value in the register R2 from the value in the register R1 is 
added to the value in the accumulator SUM, and the program then proceeds to Step T13. The accumulator 
SUM is initialized at "0\ 
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In Step T13, the average value b(j) is obtained by dividing the value in the accumulator SUM by the 
square of the number N. Then, "1" is added to the value in the counter C in Step T14, whereupon the 
program proceeds to Step T15. In Step T15, the weighted average b(j)" is obtained by dividing by "2" the 
sum of a one-cycle-earlier average value stored in a register R(b) and the average value bQ) obtained in 

5 Step T13. Then, in Step T16, the average value b(j) obtained in Step T13 is loaded into the register R(b), 
whereupon the program proceeds to Step T17. In Step T17, the feedforward amount FFp is obtained by 
multiplying the weighted average b(j) M , which is obtained in Step T15, by the position feedforward 
coefficient a1 and the coefficient P for converting the unit of the move command pulses into a speed 
command unit. Thereafter, the processing of Step S14 shown in Rg. 4 and the subsequent processings are 

jo executed. The speed feedforward amount FFv to be obtained in Step S17 is obtained by previously storing 
the weighted average b(j)" obtained in Step S15 and making the calculation according to equation (4). 

Alternatively, Step T15 may be omitted so that the position feedforward amount FFp is obtained on the 
basis of the average value b(j), and whether or not the value in the counter C is not larger than N/2 may be 
determined in Step T10. 

75 Among the processings described above, Steps T10 to T13 are processings for obtaining the average 
value b(j). The following is a description of the way these processings provide the average value of the 
move commands a for the N number of position/speed loop periods centering around the aforesaid 
position/speed loop period concerned- 
Let us suppose, for example, that the move commands Mcmd for the individual ITP periods are 

20 outputted in the order of AO, A1, A2, A3, A4, • • • (AO = At = 0), as shown in Fig. 12. If move commands 
obtained by dividing A2 and A3 by every position/speed loop period are a20, a21 , a22, a23; and a30, a31 , 
a32, a33 (division number N = 4), the average values obtained are as follows (Table 2). 

Table 2 



n 


Mead 


C 


SUM 


b(j) 


1 


Al 


0 


0+A1-AO=0 


0 






1 


0+A1-AO=0 


0 






2 


0+A2-Al = A2 


A2/16=a20/4 






3 


A2+A2-A1=2 A2 


2A2/16=(a20+a21)/4 


2 


A2 


0 


2 A2+A2-A1=3 A2 


3 A2/16=(a20+a21+a22)/4 






1 


3 A2+A2-A1=4 A2 


4 A2/1B*( a 20+ a 21+ a 22+ a 23)/ 4 






2 


4 A2+A3-A2=3 A2+A3 


(3 A2+A3)/16=(a21+a22+a23+a30)/4 






3 


3 A2+A3+A3-A2=2 A2+2 A3 


(2 A2+2 A3)/16=( a 22+ a 23+ a 30+ a 31)/4 


3 


A3 


0 


2 A2+2 A3+A3-A2=A2+3 A3 


(A 2+ 3 A3)/16 c (a 23+ a 30+ a 31+ a 32)/ 4 






1 


A2+3 A3+A3-A2M A3 


4 AS/16* ( a 30+ a 31+ a 32+ a 33)/4 



In this manner, the average value b(j) can be also obtained by the processings of Step T10 to T13. The 
feedforward amount FFp can be obtained without any delay or lead by taking the weighted average of the 
average value b(j) obtained in the position/speed loop period concerned and the average value obtained in 
55 the one-cycle-earlier position/speed loop period. In the example described above, the average value b(j) 
obtained in the first position/speed loop period (counter C = 0) when the ITP period n is n = 3 is based on 
the sum of the move command a30 for the position/speed loop period concerned, the move command a23 
for the one-cycle-earlier period, and the move commands a31 and a32 for the one- and two-cycle-later 
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periods. In other words, in this case, the calculation is made according to equation (2). On the other hand, 
the average value b(j) obtained In the one-cycle-earlier position/speed loop period (when n = 2 and C = 3) 
is based on the sum of the move command a30 for the position/speed loop period concerned, the move 
commands a23 and a22 for the one-and two-cycle-earlier periods, and the move command a31 for the one- 
5 cycle-later period, and the average value is obtained by making the calculation according to equation (1). 
Thus, the weighted average b(j)" can be obtained by adding the average value computed in the period 
concerned and the average value computed in the one-cycle-earlier period and dividing the resulting sum 
by 2. 

In connection with the aforementioned embodiment, the ITP period has been described as being 
w divided into four. However, it may be divided in any other number than four, provided that the move 
commands a for the N number of periods centering around the position/speed loop period concerned are 
leveled. 

According to the present invention, even though the distributed move command from the host control 
device, such as the numerical control device, varies in stages, the variation of the position deviation 
15 deceases, so that a shock acting on the action of the motor or machine can be reduced. In the case where 
the number of the position/speed loop processing periods, which is obtained by dividing the distribution 
period, is an even number, a position feedforward amount without any equivalent time delay or lead can be 
obtained by taking the weighted average of average values obtained with a one-cycle shift with respect to 
the cycle concerned, so that more accurate control can be enjoyed. 

20 

Claims 

1. In a. control method for a servomotor in which a position/speed loop processing is executed for each 
period obtained by dividing the distribution period of move commands distributed from a numerical 
25 control device into N number of parts so that move commands for said position/speed loop processing 
are obtained according to the move commands with said distribution period, the feedforward control 
method for a servomotor comprising steps of: 

(a) reading and storing a move command for a distribution period one cycle later than the 
distribution period concerned; 

(b) computing each move command for the position/speed loop processing period in said one-cycle- 
later distribution period; 

(c) obtaining the average value of individual move commands for N number of position/speed loop 
processing periods centering around the position/speed loop processing period concerned; 

(d) obtaining a position feedforward amount by multiplying said average value by a position 
feedforward coefficient; and 

(e) obtaining a speed command for a speed loop processing by adding said position feedforward 
amount to a speed command obtained in a position loop processing. 

A feedforward control method according to claim 1, wherein said step (c) for obtaining said average 
value includes (c1) obtaining the average value of N number, in total, of move commands for the 
position/speed loop processing period concerned, N/2 number of past position/speed loop processing 
periods preceding said period, and (N/2 - 1) number of later position/speed loop processing periods, 
when said division number N is an even number. 

A feedforward control method according to claim 1, wherein said step (c) for obtaining said average 
value includes (c2) obtaining the average value of N number, in total, of move commands for the 
position/speed loop processing period concerned, (N/2 - 1) number of past position/speed loop 
processing periods preceding said period, and N/2 number of later position/speed loop processing 
periods, when said division number N is an even number. 

A feedforward control method according to claim 1, wherein said step (c) for obtaining said average 
value includes (c3) taking the weighted average of the average value of N number, in total, of move 
commands for the position/speed loop processing period concerned, N/2 number of past position/speed 
loop processing periods preceding said period, and (N/2 - 1) number of later position/speed loop 
processing periods and the average value of N number, in total, of move commands for the 
position/speed loop processing period concerned, (N/2 - 1) number of past position/speed loop 
processing periods preceding said period, and N/2 number of later position/speed loop processing 
periods, when said division number N is an even number. 
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5. A feedforward control method according to claim 1 , 2, 3 or 4, further comprising: 

(f) obtaining the differential value of said average value for said position/speed loop processing of a 
period, which is later than the position/speed loop period concerned by being advanced by a 
predetermined number of periods; 

(g) obtaining a speed feedforward amount by multiplying said differential value by a speed 
feedforward coefficient; and 

(h) obtaining a torque command for the servomotor by adding said speed feedforward amount to a 
torque command value obtained in the speed loop processing. 

6. In a feedforward control method for a servomotor, in which a position/speed loop processing is 
executed for each period obtained by dividing the distribution period of move commands distributed 
from a numerical control device into N number of parts so that move commands for said position/speed 
loop processing are obtained according to the move commands with said distribution period, the 
feedforward control method for a servomotor comprising steps of: 

(i) previously reading and storing a move command for a distribution period one cycle later than the 
distribution period concerned, and previously storing a move command for a distribution period one 
cycle earlier than the distribution period concerned; 

(j) obtaining the average value of individual move commands for N number of position/speed loop 
processing periods centering around the position/speed loop processing period concerned, on the 
basis of the move command for the distribution period concerned, said stored move command for 
the distribution period one cycle later than the distribution period concerned, and said stored move 
command for the one-cycle-earlier distribution period; and 

(k) obtaining a speed command for a speed loop processing by adding a position feedforward 
amount, which is obtained by multiplying said average value by a position feedforward coefficient, to 
a speed command obtained in a position loop processing. 

7. A feedforward control method according to claim 6, wherein said step (j) for obtaining said average 
value includes (j1) adding to the value in an accumulator a value obtained by subtracting the move 
command for the one-cycle-earlier distribution period from the move command for the distribution 
period concerned, in the position/speed loop processing periods ranging from a first division of the 
distribution period to an (N/2 - 1)'th division, and adding to the value in the accumulator a value 
obtained by subtracting the move command for the distribution period concerned from the move 
command for the one-cycle-later distribution period, in the position/speed loop processing periods 
ranging from an (N/2)'th division to an N'th division, when said division number N is an even number, 
and 02) obtaining the average of N number, in total, of move commands for the individual 
position/speed loop processing periods by dividing the value stored in the accumulator by N 2 . 

a A feedforward control method according to claim 6, wherein said step 0) for obtaining said average 
value further includes Q3) taking the weighted average of the average value of the move commands 
obtained in said step 02) and the average value of the move commands obtained in the one-cycle- 
earlier position/speed loop processing period. 

9. A feedforward control method according to claim 6, wherein said step 0) for obtaining said average 
value includes 0 4 ) adding to the value in an accumulator a value obtained by subtracting the move 
command for the one-cycle-earlier distribution period from the move command for the distribution 
period concerned, in the position/speed loop processing periods ranging from a first division of the 
distribution period to an (N/2)'th division, and adding to the value in the accumulator a value obtained 
by subtracting the move command for the distribution period concerned from the move command for 
the one-cycle-later distribution period, in the position/speed loop processing periods ranging from an 
(N/2 + iyth division to an N'th division, when said division number N is an even number, and 05) 
obtaining the average of N number, in total, of move commands for the individual position/speed loop 
processing periods by dividing the value stored in the accumulator by N 2 . 

10. A feedforward control method according to claim 6, 7, 8 or 9, further comprising: 

(1) obtaining the differential value of said average value for said position/speed loop processing of a 
period, which is later than the position/speed loop period concerned by being advanced by a 
predetermined number of periods; 
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(m) obtaining a speed feedforward amount by multiplying said differential value by a speed 
feedforward coefficient; and 

(n) obtaining a torque command for the servomotor by adding said speed feedforward amount to a 
torque command value obtained in the speed loop processing. 
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